inverted pendulum arduino matlab lqr linear quadratic regulation state feedback observer